% 调试用函数
function draw(points,c)
scatter3(points(:,1),points(:,2),points(:,3),18,c,'.');
end




